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NOMENCLATURE 


&r> 


Rotation of n th joint with respect to Z axis. 

n-i 


<pr% 

Mn f Ln y Rn 


Angle made by the n th link with the horizontal 
Mass, length and radius of n th lint. 


Tr ansf ormat ion matrix between and i th 


frames. 

[Trans(a,b, c) 3 Translation by "a - ' along y X y axis, y b y along 

y Y y axis and y c y along y I y axis. 

Rot(axisi,0) Rotation of any link by an angle y 9 y about the 

axis 'axisi'. 




Moment of inertia of the l 4 ^ link about its own 




* >r axis. 


Moment of inertia of the i 1 *" 1 link about its own 



Kn 

Q 

CO 

COn 

? 

Co, Ci 

Sp 


y y y axis. 

tr h 

Moment of inertia of the a link about its own 
y z y axis. 

t h 

Joint stiffness of n link. 

Beneralized force. 

Frequency of forcing function, 
natural frequency of the system. 

Damping factor. 

Damping parameters. 

Spectral density of excitation. 
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ABSTRACT 

The stability and response of the end effector of a 
2JD.0.F as well as five and six D.O.F manipulators subject to base 
excitation is investigated. The manipulators consist of rigid 


links that 

are connected 

end-to-end in an 

open 

chain. 

The 

connect ions 

between the base 

and the first link 

and 

between 

two 


successive links are char acter i zed by resilient joints. Due to 
this compliance in its joints, the manipulator undergoes 
oscillatory motions when perturbed from its equilibrium 
conf igurat ion . The end effector is assumed to carry a load at its 
free extremity. When the intensity of this load reaches some 
critical value, the manipulator becomes unstable by divergence. 
The numerical values of the critical divergence load for various 
conf igurat ions of the manipulator are computed. The weakest 
configuration of the manipulator when the critical divergence load 
is the minimum is also found out. The behavior of the response of 
the end effector subject to deterministic and probabilistic 
excitations have been investigated. Finally, a comparison has been 
made amongst different D.O.F manipulators when a white noise of 
constant spectral density acts at the bases. 
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CHAPTER 1 

INTRODUCTION 


1 . 1 Preface 

Robot, in general, is an automatic, reprogrammable, 

mul t i funct lonal .mechan i cal manipulator. Ideally, without any human 
intervention, it can work independently using its own 

machine intelligence. It works more precisely than human being 
with higher repeatability and virtually no exhaustion. It can 
perform tasks such as assembly of electrical, electronics and 
mechanical parts eg. PCB , miniature ball bearings etc., peg-hole 
insertion, telechiric operations, welding of micro parts, spray 
paintings etc.. All these operations require accuracy of the order 
of 0.1 to 0.01 mm. Hence the precision of such type of robots is 
of utmost importance . 

One of the main areas of robotic development today 

concentrates itself on the control of positional accuracy. The 

controller of a robot regulates the mechanical positioning of 
'the end effector within the least amount of 'inaccuracy. This 
inaccuracy is not completely avoidable and is caused primarily 
due to joint compliance, link flexibility and incapability of the 

i 

controller to operate upon data extending to several places of 
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decimals. In recent times, there is a tendency to develop light 
weight robots which have the obvious advantage of lower space 
requirements, greater mobility and higher operating speed. For 
example, CANADA-ARM which is used in space for retrieving 
artificial satellites for repairs and then putting them back into 
the parking orbit, is a light-weight long flexible telechihic 
robot. This structure has compliance in joints and links due to 
the reduction. in cross-sections. While in operation, it undergoes 
some mot i on- i nduced vibrations which has to be damped out as 
quickly as possible so that the end effector can perform its tasks 
iwith less inaccuracy. When the mass of the load exceeds the mass 
of the manipulator, the elasticity in the links can become of 
considerable importance, as has been reported by Sunada and 

Dubowsky Cl], Moreover, if the environment in which the robot 

works is not free from vibration coming from other machineries, 
or in the case of mobile robots, where floor surface is not devoid 
of roughness and undulations, the positional inaccuracy can go up. 
Hence, a thorough understanding and quantitative analysis of the 
response characteristics of the end effector tip of the 
manipulator is required . 

1.2 FACTORS AFFECTING ACCURACY 

The positioning accuracy and repeatability of a robot depends 
on some factors such as CIO] given below. 

1> The force of gravity acting on the arm members and load of the 

robot causes downward deflection of the arm and the support 
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system. This is referred to as joint and link flexibility . 

2> Acceleration forces may act in various directions. Noticeable 
horizontal and vertical deflections occur when heavy loads are 
accelerated . 

S^Drive gears and belt drives often have noticeable amount of 
slack that can cause positioning errors. 

4> Thermal effects can expand or contract the links of the robot. 
In large robots, this effect can be of considerable 
magnitude. 

5; Bearing "PLAY" can be significant when very high 
positioning accuracies are required . 

S'? Low resolution of the control ler , in some cases may 
also be responsible for poor accuracy. 

6> The feedback errors arising out of malfunctioning of sensors 
can play a vital role . 

It is to be observed that some of the above factors may not 
have any role to affect repeatability because the inaccuracy 
in such cases may be repeatable . 

1.3 LITERATURE REVIEW 

The vibration in a moving flexible Robot arm was considered 
by Wang et al Cl ]. They have shown how the extension and 
contraction motions have destabilizing and stabilizing effects on 


the vibratory motion respectively 


The vibration analysis was 



5 


based on Galerkin approximation with time dependent basis 
function. The study restricted its consideration to the bending 
vibration of the Robot arm in one plane only. 

Meghdhari and Shahinpoor [3] presented a complete 
derivation of the combined f lexural-joint stiffness matrix and 
the elastic deformation field of a flexible manipulator. The 
stiffness properties were derived directly from the differential 
equations used in engineering beam theory. The elasticity of the 
joint was modelled by considering the robotic links attached 
end-to-end with the help of flexible connector. 

Hill and Vaccaro [43 treated a robotic manipulator 
with joint compliance to make an on-line scheme for computing the 
inverse joint solution with non-linear feedback control in joint 
space . The study used the recursive formulation scheme for 
calculation of all the elements in the dynamic equation and 
considered the vibration effect on the feedback loop. It neglected 
the existence of Coulomb friction and gear backlash in the joints. 
'Hence, some error is introduced due to the absence of non-linear 
contribution from these terms. 


S i ra-Rami rez 

et 

al [53 studied the robust 

cont ro l 

of 

robotic manipulator 

with flexible joints. 

They 

mode 1 1 ed 

/ 

the 

flexibility in 

the 

joint by incorporating 

the 

concept 

of 

" f l ct i t i ous 1 ink" 

which would take care of 

the 

comp 1 i ance 

by 
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converting an y rr' D.O.F manipulator to a corresponding 
"2n / D.O.F manipulator. 

The compliance of a structure varies with the weight it 
possesses. The lesser weight of a manipulator makes it more 
vibration-prone as the joint compliance starts taking vital role. 
In this respect, the vibratory character ist ics of an unloaded 
industrial Robot with rigid links and resilient joints have been 
highlighted by Sunada et al [53. 

Ziegler [63, Bungay et al C73 reported that certain 
classes of mechanical systems when subjected to non -conser vat 1 ve 
forces might execute different types of motions like small 
oscillation, flutter and divergence when disturbed from an 

equilibrium state. They dealt with mathematical models based on 
rigid links and resilient joints in an initially straight line 
conf igurat ion. 

The above work was followed and improved by Anderson 
C83. He investigated the stability of a manipulator subjected to 
a non -conser vat ive force applied at the free extremity. It 
includes the different modes of failure of the structure by 
instability and the computation of the numerical values of 
the critical divergence and flutter loads for various 

configurations of the manipulator. They did not consider 

frictional damping in the joints. By considering a 3_D.0.F planar 



manipulator, it lost the generality of spatial motion of a 
pract i ca 1 -purpose robot. 

1.4 PRESENT WORK 

The present work attempts to model the robot with the base 
affected by - 

a> Deterministic excitation 

b> Random(Stochast i c) excitation 

i 

The positional inaccuracies induced due to the vibration 
transmitted to the end effector have been examined for a simple 
two D.O.F as well as five and six D.O.F robots separately. A / small 
amount of damping that can play the role of controlling response 
at all values of frequency ratio is included in the analysis. To 
make it more general, the work has been extended considering 
PUMA_560 which has six non-redundant links. It also includes the 
study of the behavior of the manipulator under a constant load at 
the tip and assorted excitations at the base by giving sinusoidal, 
square and random input. By all these, a prediction can reasonably 
be made about the response characteristics of the manipulator 

when subjected to other general types of dynamic loads. The 
critical divergence load i.e the load under which one or more 
natural frequencies cease, bringing about instability in the 
system is examined at different geometric configurations of the 
structure. Also its variation with the load at the tip and with 
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different configurations are plotted to draw a general 
conclusion about the features of the system at some specific 
values of joint parameters of the structure. Finally, a comparison 
of response has been made amongst different D.O.F manipulators 
for random input excitation . 



CHAPTER 2 
MODELLING 
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2 . 1 ASSUMPTIONS 

We have modelled a simple 2_JD . 0 . F manipulator as well as 
five and six D.O.F manipulators separately with flexible joints. 
The 1 inks are connected end to end through revolute joints. The 
link connecting actuator to the arm undergoes re tive rotation 
with respect to its two ends. This flexibility at the joint is 
modelled by linear tirsional spring with spring constant ’K*. 



FIG. 2-1 ELASTIC JOINT. 

The model is based on these assumptions . 

1> The links arc totally rigid except the compliance at the 

joints. 

Z> The links are cylindrical and axisymmetric . 

3> The mass density of the links are uniform . 

4> The joints may undergo small oscillations . 

5> The motion of the manipulator about the equilibrium 
configuration is very slow. The same assumption was followed by 


AndersonCB 3 . 



2.2 LINK CO-ORDINATE SYSTEM ASSISNMENT 


3 0 

For the study of response, it is always convenient to 
set up individual co-ordinate frames to each link. Each frame will 
be related to the non-inertial base frame by linl- and joint 
parameters. To set up the co-ordinate frames, Denavi t -Har tenber g 
convention C i|f.r3 is followed as given below. 

With reference to Fig. 3 , it can be written 

th 

1- The Z axis lies along the axis of motion of the n joint. 

n-1 

2> The x axis is normal to the z axis and pointing away 

n t >-1 

from it in the direction of the common normal of z and z 

n— 1 n 

axes. 

3;- The y axis completes the right handed co-ordinate system as 

n 

required. 

By this, one is free to choose the location of 
zero lh co-ordinate frame anywhere in the supporting base, as long 
as the x axis is normal to the z axis . 

n n 

2.3 TRANSFORMATION MATRIX 

t.Vi ^ 

Let the tr ansf ormat ion matrix between the i and the (i-1) 
frames be given by T\J. Also sint©r»), cos(6n) are denoted by 

Sn, Cn and sin(^m>, cos(^m) by Bm, Cm respectively where 
m = 2,3,6 and n = 1,4,5. 



Thus, 


£ "tJ =• Trans £o, 0, ZbJ = 


0 0 


[ ° Tl ] ~ [ POT C Z ' e 0]" Jrr^ns .(0.C' r Li)]#|R 0T (y»90*3]-tf (r°T(7., 180*]] 


0 Si Ci o 

0 -Ci Si o 

1 0 0 Li 

0 0 0 1 


ro si Ci 


[ \] ■ [ \h \] - ; 


0 -Ci Si 


0 0 


(Li + Zb) 


>{isi,0i]| denotes the rotat ion about any axis axisi' 


Where, [rOT (axist, 6>i)j denotes the rotat ion about any axis axisi' 
by an angle Q± and |Vrans £x, y, z)J denotes a translation of x along 


X axis. 


along Y axis and 


along 


Z axis 


p T J = [rot (Z,©z)J« |Trans(La,0,0)J = 


C 2 -Sa 0 L 2 *Cz 
Sz Cz 0 L2*S2 

0 0 10 
0 0 0 1 


[ Et J = [ Bt *]*[ ‘ t J 


Now putting 9z = ($2 - Yl/2) where *2 is the angle made by the 



linl^ with 

the horizontal, we get 




'-Sl*C2 

S2*Cl 

Cl -L2«S1*C2 

r a 1 


-Ci*C2 

-S2*Cl 

Si L2*Cl*Ca 

T 2 

= 




L *J 


S2 

Ca 

0 (Li + t_2*S2 



0 

0 

0 1 

[ 2t J = 

ROT (2 

1 r $a-$2 

)J*|rOT (X, -90 

°)]*[r0T(Y,90°)] 

r b t 1 . | 

[ b t I 

* 

H 



L *J 1 

L 2 J 

L 8 J 




— Si*Sa -Ci 
Ci^Sa -Si 


-Ca 

0 


0 

0 


-Si*Ca <-L 2 *Sl*C 2 ) 

Ci*Ca (L2 *Ci*C2) 

Sa (Li + La«S 2 + 7.b) 

0 1 


[ "Vi = [ R0T [Z , ©*) J* |Vr an 5 (0,0, La+L*) J * |rOT [X , 90 °) J 

[ M ■ [ ■'•]•[ M 
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[S i*Sa*C4+Ci*S4.] 

-[5i*Ca] 

[~Ri*Sa*S4+Ci«n4 ] 

[Sa*Ci*C4-Si*S4] 

[Ci*Ca] 

[Sa*54*r,4+Si*r4 ] 

[-Ca*C4] 

[Sa ] 

[-S4*Ca] 

D>] 

[0] 

[°] 



-5i*£ (La+I. 4J«Ca +I_ 2 *C 2 



Ci* [(La+l_4')«Ca + Lz+Cz] 


[<La+l_4)*Sa+L*-H_a*Sa+Z»] 





Cs 0 ~Ss 0 

Ss 0 Cs 0 

0-3 0 0 

0 0 0 1 _ 



14 1 

[ %] - [ M*[ ■ 

— [(Si*Ss*C4+Ci*S4)*Cs + Si»S*s*Ca] [Si*Sa*S4 - Ct*C4 ] 

[<Sa«C**C4-Si*S4>*Cs + Ss*Ci«Ca] - [S4*Sa*C* - Si*C,4 ] 
[-C»*Ca*C4+Sa*Sa] [S4*Ca] 

[o] [o] 

[(Si*Sa*C4+Ci*S4)*Ss-Si*Cs*Ca] [-Si*l (La+l_4>*Ca+L2*C2}] 
[-CSa*Ci*C4-Si*S4)*Ss+Ca*C**C»] [Ci*C (La+L.4)*Ca+La*Ca 
[Ss**Ca»C4 + Sa*Cs ] [(La+L4)*Sa+Li+La*S2+ZB] 

L t°] [ 1] 

This chapter has dealt with transformation matrices relating 
different link co-ordinate frames with that of the base. Thus the 
potential energy and kinetic energy of the system which is nothing 
but the summation of the same of the individual links, can be 


found out with great ease in the next chapters 3 and A. 
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CHAPTER 3 , 

DYNAMICAL EQUATIONS OF A TWO DEGREE OF FREEDOM MANIPULATOR 

Before going to the comp lexi ty of a 6_D.0.F robot, let 
us tale the case of a 2_D.0.F robot and analyze it to get an 
insight into the problem. In order to find the equations of 
motion, the potential and the kinetic energy of the system at any 
arbitrary configuration is desired. 

3.1: KINETIC ENERGY <KE> CALCULATION 
A> KE OF THE FIRST LINK 

With reference to Fig. 2.1, it can be shown that 


Y*Si + 7 *Ci 


[■'.H M- 


-Y«Ci + Z*Si 

-X + Li + Zb 

L 1 


where, 

pP 1 J = [ -X Y Z Jj, denoting the position 
vector of any point on linkt with respect to the l" 4 co-ordinate 
frame . 

By differentiating, we get 
(Y*Ci - Zi*S i ) *0i" 

•• t 

(Y*si + z«ci)*ei 

Zb 

0 

Let KEi denote the kinetic energy of link 1. 

KEi =■ *VelJ * dm 

ml 
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Where, 

I’VelJis the velocity of the first lint with respect 


the base frame. 
Now, 


f B Ve 1 1 = 

" B - ‘ 


Is ' 

. 2 

r 2 *i 

l *J 

P 



= (©±) * 

Y + Z 


i 


p 


J 




i 


L J 


• • 


m m 




Therefore, 


KEi = 


2 2 .2 .2 

0.5*)|<Y + Z )*(©i) + (Zb) l*dm 


■K' 


)■ 


* n 2 m2 

= 0. 5*Ji» f .©i) + 0 . 5*mi*( Zb) 

Where, 

Ji is the polar moment of inertia of the 3* 1 link. 
B'/ KINETIC ENERGY OF THE SECOND LINK? 

The position vector of any point on link 2 in the base frame is 

X»Si*C2 + Y*S**S2 + 7*Ci - Li*Si«C2 
Z*Si - X*Ci*C2 - Y*S2 »Ci + L2*C2«Ci 


1 -'Jfr.] ' f ',] 


YC2 - X*S2 + Li + L.2*S2 + Zb 


where , 


[■ - y 


L 


-X 

Y 

Z 

i 


to 



17 


Now , 

KEz =• "Vei J * rim 

m2 


Where , 

I’Vel^is the velocity of the second link with respect 
to the base frame. 


B 

. 2 

2 2 2 

z 

2 .2 m2 

Vel 

= <©4)« 

I * ( S2 ) + 

I *<Cz) 

+* I *($ 2 ) + (Zb) *>ti2 

2 


XX 

. 

yy 

z z 


mm 2 mm 

- (©1 >* (§2)*C2*M2*L2*0. 5 + t$ 2)*< 7 b)*C2*ITi2«L2 

2 

Here, I is the moment of inertia of the secono link with 

XX 

2 

respect to the X 2 axis and I is the same with respect to the Y 2 

yy 

axis. 

3.2 r POTENTIAL EN£R6Y(PE> CALCULATION 

The potential energy of any 1 ini*' would consist 

of two par ts. One would be coming from the conservative forces due 

to gravity and the other would be from spring force due to 

joint compliance , As the n th joint is rotated through an angle 0r>, 

a restoring moment of kn*$n is* induced in the joint. This is 

contributing to increase in P.F.of the system. The potential 

energy of the system ( PE*y«) can be written as the summation of the 

potential energies of the first and the second links, 

PE«y. = PEi + PE 2 

= Mi*g*(0. 5*Li + Zb) + M 2 *<Li + Zb + 0.5*L2*32)*g 

2 2 

+ 0. 5*K2*( <p 2 - #20 > + 0.5«Ki»(©i - © 40 ) 





Whpre <pzo and 0io are the equilibrium angle?, of linl* 
and linki respectively. K* and Ki denote the rotational stiffness; 

of the respective joints. 

3.3 LAGRANGF 'P l"OU AT I ON 

Lagrange s equation in terms of generalised force and 
co-ordinate is 



Where , 

L is called the Lagrangean and L= (KE»y« - PF«y«> 

qk and Qk are the generalised co-ordinate and force respectively. 

3.4 CALCULATION OF GFNFRAI TSFD FORFEB 

Let us choose 7 .b , 0i r and <p 2 to be the generalised 

co-or d inates. The corresponding generalised forces are Qb, Q± and 

0*. When there is a virtual displacement in the sys.tem from 

the equilibrium configuration, the virtual work done(vwd) is 
given by 

VWD = <Ui - Tfi)*d©i + (Ua - Tfz.)*d^a + p.dftp 

Where ftp is the position vector of the end efector tip 
with respect to the base frame and Ui r U2 are the joint 
torques of the respective joints. Tfi and Tf 2 are the frictional 
torques at the joints . 

b A A A 

Rp = -L*»C*»Si»i + La*Ca*Ci*j + (L* + La«*S2 + Zs)*k 



io 


Where 1 , j , t- are the unit vectors along Xb,Yb,Zb axis. 

Now r P - -P*K 
Hence r 

?.dftp = -P*L2*C2«d<^2 - P*cIZb 
VWD - (Ui - Tfi)*d©i + <Uz - Tfa - P*i. 2 *C#s}*d <*2 - P*Zb 
So, the generalised forces are t 
Q± = Ut - Tfi 
02 = U 2 - Tf2 - P*L.2*C,2 
Qb = -P 

3,5 EQUATION OF MOTION 

In order to find the equation of mot ion,Lagr ange s 
equation is used for each of the generalised co-ordinates -Taking 
Qi and ©i as the generalises force and co-ordinate respectively, 
after going through some mathematical operations, we get. 

Ui - 0 . .......... . . 3.2 

Similarly, taking Q 2 and # 2 , the corresponding equation is 

mm j m a . 

^> 2 « 2 I + =*Zb*M 2 *L_ 2 *C 2 + K 2 * ( <pz - <fao) +• i»M 2 »L 2 *g*C 2 

SSSZ5 4* xL 

= U2 - P»L2»C.2 - Tf2 -3.31 

Taking Qb and Zb, 

11 n #* k t» 

(Mi + M 2 ) Zb + 0,5*M2*L2*C2*^2 - 0. 5*Ma*L**Sa* (* 2 ) * 

+ (Mi + Ma>*g - -P . . . 3.4 

The first of these equations shows that the 
external torque to be applied in the first joint is zero 


because there is no disturbing couple in the axial direction of 
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the first link . 

The second equation is actually the vibration equation ial ing 
care of the spring ^damping and external forces. 

The third one is coming from the dynamic equ i 3 i hr i urn of the 
struc Uire by considering the force balance in the vertical 
direc 1 1 on. 

3.6 SIMPLIFICATION 

In this section, some simplifying assumpt i ons have been rnaoe 
that will permit the reduction of the comp lex 1 1 y of the 
differential equation 3.3 . It is assumed that the system 1 s m a 
state of equilibrium when <pz - <pz o and ©i= ©10 with Uk- s denoting 
the torques applied at the joints. 

At equilibrium configuration, equation 13 . 3 j reduces to 
liz*L2*g^C2O*0 . 5 =■ U2 - P*I_2*C20 

Now, as mentioned earlier, the motion of the manipulator being 
small about the equilibrium cortf i gurat 1 on , one can write 

^ko + ^kk(t>, where j 4>kk J < '. I 

In particular, it is assumed that one can make the approximat ion 

COS(^kk) = 1 

sin(flfckk) = <£kk 

Therefore, 

r-u 

si n ( ^k > =■ sin (^ko) + ^kk*cos ( <£ko> 
analogously, 

cos(^k) = COsC^ko) - ^kk*Sin(^ko) 
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The terms like 4>\c*7b are ‘jgnorecL 

By using these simplifying assumptions, it can he written, 

St m m m 

*zz ^ 22 + *-' 2d *^ 22 + [ K2 - (Ii 2 *g* 0.5 + P ) *L2*S2oJ *^>22 

» 1 

_ - M2*l_2*C20*ZB 

— — *T 

§2 + 2*?*«n*^22 + 0>n X *<pZZ = ^^ - 9 2 ?* Zb 3. B 

2 

2* I 

zz 


Where r 


2 


0>n 


«2 - ^Ii2*g*0.5 +P}*L.2*52 



zz 


? =s y C 2 d being the darnping co-efficient , 

2**1 ♦o>n 
zz 

3.7 DETERMINISTIC EXCITATION 

3.7.1 r SINUSOIDAL EXCITATION 

Let sinusoidal excitation arts at the base of the manipulator 

and is given by Zb = Zo*sin i<a*O r where Zo is the amplitude and « 

is the frequency of the forced excitation . 

Hence, equation 3 . 5 . can be written as 

mm m 

2 

<£22 + 2*?»o>r>*^22 + un *4*22 = V*sin (o >*0 . ........... 3 . 6 

Where V = M 2 *L 2 *C 2 *Zo*oo 2 / < 2* 2 I ) 

ZZ 

The above equation 3.6 has to be solved for the transient as well 
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as steady state. 

The three transient solutions depend upon the value of 


CASE Is ? : 1 


- e 

/ tram® 


■ ( dcay*t ) 


[Ci»e 


(dfq*t ) 


+ C2«H 


-tdfq*t) 


CASE 2: ? ' 1 

^* 2 /trar>« ~ p - [Ci*cos (df q*t > + C 2 »sm < df q*t ) ] 


CASE 3; ?=3 

^**/ trotn. = CC:l + C2*t l**"*""** 3 
The particular integral is 

PI = A*s i n ( <o»t + <f>) 

Where, A =V/[y/ [l - Cco/wrO 2 ) 2 + (2*?*w/wn) * 
4 > = tan 1 -i 


Hence the complete solution is 

da* = dtzz . + P I . 

/ trana 

As the response of the second joint is known , the response of 
the end effector can be • found out with respect to the base 
co-ordinate frame . The vibrations in the Xb,Yb,Zb directions are 
given by 

Ei = - L2*Sl0*S20*#22 
Ej = L**C*0*S20*^22 
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Ek = Lz*Czo*4az + Zb 

3.7.2 SQUARE IMPULSE EXCITATION 

A square inripui.se excitation at the base having an amplitude of Zo - ' 
and period '"tt" is assumed to act at the base of the robot. 
The pulse can be represented with the help of Fourier series as 
f ol lows: - 


Zb — Z a v +■ 

oc 

2*Zo V 1 . 

ir 2" 

n=4 

TI*n«ti 

•cos 

n»t ±*n 

2n»n* t 




tt 

1 1 

.! 

Hence, the 

solution of 

equation 3-5 

W j i h 

square 

1 1 


3.7 


above type is given by 

a 




X AMPn f2n*n»t ] 

\ "HLH * %in + L.AGn 

A- Wn tt J 


Where , 


Az2, is same as before . 

/ 1 ran* 


. . A „ n n*n»ti ^ . -i fn/ttn) „ . ,2 .O 

and LAGn = ^ ^ + tan | s / (_< tofn/ ton) — I J I 

Where, tofn = 2I1*n/tt 

The response of the end effector can be found using the same 
expressions as in the case of sinusoidal excitations . 

3.8 s RANDOM EXCITATION 
3.8.1 : ASSUMPTIONS 

Let us now consider random excitation at the base of the 
manipulator . Any random process can be character ireci by the 
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probability density and distribution functions such that spectral 
density , auto-corr el at i on function , mean squai e value etc.. The 
most general type of random excitation is too complex but 
some of the random processes have been studied extensively in 
literature t 13 — 15 ;i with respect to vibration problems. 
The random process under consideration is based on some 
assumptions. These are 

1' The random process is ergodic. ano stationary . 

2 > It follows baussian distribution . 

3; The spectral density of excitation is constant over feasible 
range of frequency . 

3.8.2 COMPLEX Rl-CLPTANCE 

Let the spectral density of excitation be denoted by Sp .In 
order to find the spectral density of response at the tip, the 
cotTip lexreceptance of the system is to be found out. Lei 1 1 be 
denotedby w) . Hence, for a load of Zb = Zo*e iwt , with the help 
of equation. 3. 5 the response of the second joint can be written as 
<pzz = oc( iw)»Zo*e . 



Where 
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M2*L2*C2O*0l>** ( 1 - Fr*) 

OCr= 

Fr , the frequency ratio =• " 

ton 

and, 

M2*L2*C20*to 2 *2*f *Fr 

OCX TO* 

3.8.3 .• SPECTRAL DENSITY OF THE RESPONSE 

After the complex recepiance of the system is known, the 
spectral density of the response can be related to that of 
excitation . 

The response of the end effector m the vert 3 cal direction for 
any Zb is given by , 

Ek = L 2*02*022 + Zb 

= JL 2 *C 2 *«( io>) + 1 J*7o*e' - ° vt: 

Ek -• Ekf.iw)*Zo*e v&>t 

— ( Ekr - i*Ekxm) *70*6^^ 

Where , 

Ekr = 1 + L2*C2O*0Cr 

and 

Ekim = L 2*C 20*0dm 

Hence, 




|Ek(ito)|* = Ekr* + Ekim* 
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Similarly, for the Y component of response 
|Ej( lfa>) | = t E jr ) + i E jim ) 2 

Ejr = - t_2*S**Ci*<» 

E Jim = - L2< t S2*Cl*0&m 
And finally for the X -component, 

| Eif HW) | 2 = <Eir) 2 + (Evim) 2 
Eir * L.2*S2*'3 i*0O- 

Enm — i_2»S2»Si*oCtm 

The spectral density of f etponse m any direction n' may be 
expressed as 

Sn(w) — |En( iw) | 2 *Sp(c*>) 

3.8,4 MEAN SQUARE VALUE OF THE RESPONSE 

The mean square value of the response of the end effector can 

be found by the following integral- 

, 2 

<Er» 2 (t )> = jjAjj */* jEndto) I«8p*d« 

^ o 

q 2 

f Er, 2 ( t > > = *S OC |En< ico) |*dw 

The above integral of the mean square value c:*n be 
calculated with the help of Residue Theory or by any standard 
procedure of numerical integration 

For a linear system ,if the input excitation follows Gaussian 
distribution ,the response will also follow the same distribution 
CiSQ . 


As the system under consideration is linear 


by making use of 
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this proper! 

wr x te , P (Erd 


y, after assuming ?ei , o mean of the r 


1 - _-En 2 /2o-n 2 

■ c^-/T2*n> e 

2 2 

Where, on - •■''En(t) 1 and js called 


esponsc one 


the variance. 


can 


3.9 SUMMARY 

This chapter has described the position of the end effector 
of a 2_D.0.F robot at any joint conf igurat ion. Thus the deviation 
of the end effector from a particular desired position can be 
obtained at any instant of time. The behavior of the response of 
the end effector at various frequencies and spectral density is 


shown in chapter 5 
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CHAPTER 4- 

DYNAMICAL EQUATIONS OF MULTI-DEGREE-FREEDOM MANIPULATORS 

4.1 5_D.0.F SYSTEM 

4.1.1 : K.E AND P.E CALCULATION 

Following the same procedure as depicted in chapter 3, one can 
arrive at the expressions of the K.E and P.E of the 3 rd , 4 th and 

the 5 th links as follows 

(K.E)a = 2*1 I *(^i) + i*Ma«L 2 2 *(*«) + Ma*L 2 *C 2 *^ 2 »ZB 

1 * ’ 1 ■ 

+ 2*l w l»*l_2»La*cos(^2-.0a)*^2*^>9 + 2*Ma*La*Ca»ZB*0a 

1 * 

(P.E) a = i*Ka*[0a - <pao + <pzo - ^ 2 ] 

+ [Li + Zb + L2»S2 + ^•Sa]*Ma*g 

(K.E)* = i*M**L2**(^2) 2 + k**l *(* ) + ^*M*«(Zb) 2 

2 2 yy * £. 

• • I « ■ 

+ M**L 2 »C 2 *« 2 *Zb + M4*L2* [La + ]»Ca 2 ** 2 **a 

+ M**[l^a + -±.^*Ca*4te*ZB + I*q«(^a) 2 

Where, 

!•« = 0.5* 4 I + 0.5«M**(La +*) 2 - 0. 5»M**L**(La + L*) 

ms 

2 

+ Oa 125*h4**L4 *s:m(2©4>« 



so 


(P.E) 4 = Zb + Li + L 2 *S 2 + (La + 0. 5*1.4) oSa ] 

+ 0 . 5 * K 4**(©4 - © 40) 2 

< K . E ) s - 0. 5*Ms*L2**(^>2) * + 0.5*ICs 2 * S I + 5s 2 *®I l*(d>*) 

L ** yy J 

+ 0- 5* [(S4*Ss) Z * 5 I +f(S*^C5) 2 + C4 2 >°I + Ms* ( La-R. 4 ) 2 

L Z* v J v\/ 




4 *sin(204.)*C» + M»*L»*tLa + L*) *Cs;]*(^a) + 


•(Ca.Caa -Sa.C..Saz)+ Ma.LatLa+L.J.Caal^a.^a 


MaaLaaLa. [ S4 . £ 


mm - • -1 

S 4 *Ss*Ca 2 *^ 2*^4 - (Ca 2 *C 4 *Cs - Sa 2 *Ss)^> 2*^5 J + 

|s..Sa»Ca»°I yy . Sa«Ca» Ma * Lg - ttST!-—'* 1 -? * L ’* ) »Sa»Saj»»a»L 


[c..’l -SaaCa.^; 1 -’’ + «E*^li=l±k 

I yy 4 2 


- } *C4*CsJ 


* * I K«I^IC “ " 

*<ps*<t>5 + S3*- 1 — - — ■ *^4*^5 


+ ["(Ca^Cts ■Sa»Sg»C4)» -y*»?" + M5*(La + L4>*Cal*#a*ZB +M»*L2*C2*^>2 *Zb 


+ ! 1 » k* m j(Ca»C 4 »Cg - Sa*S 5 )*^s*ZB - S 4 *Ss*Ca*^ 4 *ZB 1 + 0 . Zb) 2 


(P.E)sj =Ms*g* Zb+ Li +L 2 *S 2 +(La + L4.)*Sa + y *<Ss*Ca*C4 + Sa*Cs) 


+ i- *Ks *(©5 - ©SO)* 


4.1.2 CALCULATION OF GENERALIZED FORCES 

Let the generalized co-ordinates are ©i, <pn r <p9 r © 4 , ©s r and 
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Zb. The corresponding generalized forces are Qi, Qs, Qa, Q« r Qb and 
Qb. Using the same procedure as that of the 2_D„0.P robot, one can 
obtain the generalized forces for a 5-D.Q.F system, 

Thus, 

Qi = Ui 

Qz = U 2 - Ua - P*L2*C02 

Qa = Ua - P*[t La + L*)*Ca - Ls*Sa*Ss*C4 + Ls*Ca*Cs ] 

Q* = U4 + P*Ls*S4*Ss*Ca 

Qb = Us - P*Ls* [Ca*C4*Cs - Sa*Ss] 

Qb = - P 

4.1.3 : EQUATION OF MOTION 

Applying Lagrange s equation for each of the independent 
co-ordinates, one can get the equation of motion of the 
system. Considering the equilibrium of the system at 0k = 0ko , 
applying the standard technique for I mear isat ion and neglecting 

a a a 

2 

the terms like 0j*0k and (0j) , the set of coupled linear 
equations obtained are given below. 


Mli*022+ 

Mi2*0aa+ 

Ml9*044+ 

Ml4*0BB+ 

K 11*022+ 

K 12*098+ 

K 18*044 



+K 14*055 = 

Pi 




w m 

M21*0Z2+ 

a a 

M22*^8»+ 

m m 

Maa*044+ 

a * 

M24*0BB+ 

K 21*022+ 

K 22*^>99+’ 

K 28*044 



+K 24*0BB * 

P2 



> M 8 si r* It 

8 8 

Mai*022+ 

a a 

M 824088+ 

m m 

MS8*044+ 

a a 

M34*055+ 

K 81*022+ 

K 82*098+ 

K 88*044 



+K 84*055 8 

Pa. 



a * a a r . 4 

a a 

M41*022+ 

a a 

M42*0aa+ 

a a 

M 49*04 4+ 

a a 

M44*0SS+ 

K 41*022+ 

K 42*098+ 

K 48*044 
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+K*4*^S5 * P*. . . 4.4 

We can write ail these equations in matrix form as follows. 


[ 

M 

][*' 

]* 

[ " 

][ 

x]. 

N 

where 

F 










Mu 

Ml 2 

Mia 

Ml4 


r 



M 21 

M 22 

M 2 a 

M24 


[ 

M 

]- 

Mai 

Ma 2 

Maa 

Ma 4 





M41 

M42 

M43 

M44 





Kn 

K 12 

0 

0 





K 21 

K 22 

K 23 

K 2 4 


[ 

K 

]■ 

0 

K82 

Kaa 

K84 





0 

K 42 

K 43 

K 44 







T 

“ 


[p i 

= 

[ Pi Pz Pa 

P4 

] 









T 


[ x . 

]■ 

= [ 

<p9 a 

<P** 

<pas ] 


pi 

77? 

, M 2 

v o 

+ Ma 

m : 

+ M 4 + Ms >K_ 2 *C 20 *Z] 


- 4. 5 


Pa - 


[ { .. + M4»C La + ) + Ms ( La + L4 ) >*Cao 


+ ( Cao^Csto - Sao*STO«C40 )* 


Mf**Ls 


]. z. 


— C S4o*Sso*Cao )• Za 


P* = - ( Cao*C40*Cso - Sao*3so >Za 



32 


Mu = [^1 + + M4 + Ms)*La a ] 


Mia - Mai— Mo»La»Ls*(Cso»Caao - S 50 *C*o*Saao) *0. 5 + 

M»*La*<La + l_4 ) *Caao + - a * L2 * La *Caao + M4*La* ( La + *±)*Caao 


Mia = Mai= - 0 . 5*M3*La*Ls*S40*Sso*Caao 


Mi4 = M*i — g" * ( Cb2o*C 4o*Cgo - Sazo^Ssso^ 

Maa = a I + (S40*Soo.) a *®I + f(S40*Cso) 2 + C4o a l*®I + Ms*(La + L.4> : 

zz zz L J yy 

- Ms*Ls* [( La + L4 )»Cso - ^ *s> 3 n C 2©4o.) *Cso] + 2*1 eq 


S 40*3 30*CsO* 5 1 + Ss0*C40*— — — — 


Ms*Ls 


*CLa + L4>*S40 *Sso 


Ma4= M4a= C40*®I - S*o*Cso * ^ 9 * ( Ls ~ ) + 0 . 5*Ms*Ls* < La+L_4) *C4©*Cso 

yy 4 

Maa = *1 + (Cto)V*I + CSso)** 5 ! 

yy ** yy 


M84 = 

M4B = 

» i 

M44 = 

®I 



yy 


Kn = 

Ka + 

Ka 

Kia = 

Kai = 

- 

Kia = 

Kai = 

0 


♦S 50 


= Ka + Ka - |\o.5*Ma + Ma +• M4 + Ms)*g + pJ*La*Sao 
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Kl4 

KZ2 


K41 = 0 


£0l4*(L» + 0.5*L4) + Ms* ( La + L4)]*g + P*(Lb + L 4 )J*Sao 
Jsso*C»o*C4o + Sao*Cso^|*|p + »l_s + Ka - ^ 8 *b?**— - * S ao 


Kza 

K 24 

Kaa 


KS2 

K 42 

K4 


Sao*S40*Sso* (P + ^£i)*Ls 
- C Sao*C40*Cso + Sso*Cao) * (P + 
Cso*C40*Sso* (P + -%*^) *Ls 


K»4 = K48 = - Cao*S40*Cso* (P + -?*^ »Ls 

K 44 = - ( Cao*C40*Sso + Cso*Sao) * (P + + Ks 

4.1.4 FREE VIBRATION ANALYSIS 

Now let us concentrate on the free vibration analysis of the 
system to obtain a condition from which the system natural 
frequencies can be found out which would be of much help to know 
the behavior of the system when subjected to forced vibration. 


Let us assume that 




*f (t) 


1 

mdi 
mda 
- mda- 

Hence by putting this in matrix equations, we get 


Where 


r |mdj 


+ 


4.6 


[ M ] [md]*f (t) 


[ k ] [md]*f It) = [ 0 ] 
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T 

f(t) — tmd 3 CK3 Cmd 3 2 , 

___ = - "» tw) 

rmdKMKmd] 

[-«*[ M ] ♦ [K ]].[ md ] = C03 


For non-trivial solution of rmd] , 




i 

-<o*[ M ] + [ K 

] = con 


' [K 11 


[K12 - « Z *lil2] 

[- w 2 »M*a] 

[- 



[ K 21 

- 

Q<22 - 0> 2 ♦Mzz] 

[K 28 - « 2 *ti 2 a] 

Q<24 “ W 2 »M2*] 



[- 

co 2 *Mai] 

[Kaz - («> 8 *Ma 2 ] 

[Kaa - w 2 *Maa]J 

[Ka* - <o 8 *Ma*] 


=0 

L C” 


Q<42 - <«> 2 »M*2] 

jK*a - w 2 *li*a] 

[K«4 ~ 0> 2 *li*4]J_ 




By expanding the 

above determinant, we 

get 


8-degree polynomial of the following type. 

A «(a>) 8 + A + A *(«)'* + A *(<•>>* + A = 0 4 1 

0 1 2 3 4 ' 

Where A , k = 0,1,2, a, 4 are constants to be obtained by 

k 

expanding the above deter nanant . 

We call this equation as frequency equation. 

The solution of the frequency equation would give four pairs of 
roots that may be real, imaginary or complex. If the external 
load 'P' at the tip is less than a critical value then the eight 
roots can be expressed as +«., j = 1,2, 3, 4, where « > 0. In 

J J 

such case* the rriotion of the rnanipulator is stable* These natural 
frequencies are functions of the equilibrium angles K = 2,3 
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and 3 ko ,K = l r 5 i .e, the natural frequencies of the manipulator 
depend upon its current geometric configuration. In the 
description of the numerical calculations that will be reported in 
chapter C?3, indications will be given on how the values of 
vary with the equilibrium angles . 

4.1.5 : MODAL ANALYSIS 

Now our aim is to find the modal vectors corresponding to each of 
the natural frequencies in a bid to find the mode shapes and 
later on to obtain the modal matrix which would help enormously to 
decouple the coupled set of equations Ceqn.4.1— 4.4 3 obtained so 
far. Now r going back to equation,, for any o>, we can write 
(Kn - ch>$M 41>+ mdi*(Ki 2 - coSmiz ) + md 2 »( -oo^liia) 

+ md»*( -wSmi- 4 ) ““ 0«a**«aKaata 4*»9 


( K 21 - wiri 2 i) + mdi*(K 2 z - wi M 22 )+ mdz*(K23 - w^Mza) 

+ mda*(K 2 * - <«Ai24) = 0 4.9 

( -coiliai) + md*»<.K »2 - o>^Ma 2 ) + mdz»(Kaa - w^Maal 

+ mda*(K34 -c^Ma4l = 0 4.10 

(-coili4i)+ mdi*(K42 - to&l42> + md2*(K4a - a^l v l43) 

+ mds*(K44 -toiM44) = 0.. 4.11 


Out of these four equations only three are independent and 
the rest is dependent on these three. This is not at all 
surprising because at the time of finding the eigen value 
solution the corresponding determinant was cond 1 t iona 1 3 y assumed 


to be zero. 
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So one can now solve any three equations to find the 
modal vectors corresponding to all natural frequencies . 

Thus the modal matrix can be written as. 



‘1 

1 

1 

1 


md2i 

md22 

md 2 a 

md24 

MODE ]= 

mdai 

mds2 

mdaa 

mda« 


md-Ai 

md«2 

mcUa 

md«4 


4.1.6 INCLUSION OF DAMPING! 

Let us now incorporate damping in the system. If the damping 
matrix be denoted by Cel, the original matrix equation -4.5 can 
be modified as 

CMHxi + trim + C K 3 II X 3 = IIP 3 4.12 

To choose a suitable damping matrix for a particular system 
with reasonable accuracy } is a highly controversial and 
questionable issue. Because the only way to get a suitable damping 
matrix is to perform an experiment with the system under 
considerat ion, simulating accurately the operating atmosphere of 
the system and then to evaluate the elements of the damping matrix 
by proper analysis of the experimental result. Now the first 
bottleneck that one has to overcome in doing so is to simulate the 
actual situation in the laboratory which, in most of the cases, is 
very difficult, if not impossible. The second difficulty lies in 
measuring all the required experimental result with the level of 
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accuracy desired. Moreover, even if the exper imental results 
are available, the effort required in performing so hardly 
satisfies the reliability aspect of it. So some of the very 
popular empirical approaches are used in practice which at least, 
seems to be reasonable to strike a balance between the reliability 
and the effort required in forming them. Author, in the present 
work has adopted one such approach which considers the damping 
matrix as a linear combination of mass and stiffness matrix. This 
approach is suggested by many of the famous persons in the arena 


of dynamics eg. Clough and Pengien C173. 

So, we can write. 

Cel = co*CM3 + ciTKl 

Putting this in equation C4.123, we get 

* • • « 

CM3 CX 3 + co*CM3 C X 3 + c**CK3CX3 + CK3CX3 = CP3 4.13 

4.1.7 : DECOUPLINS 

Let CX3 = CMODE3CU3 4.14 


T 

where CU3 = CUi Uz Ua U*3 
and 

Ui's, i = l , 2, 3, 4 are the independent 

coordinates. 

Putting equation 4.14 in equation 4.13 and premultiplying the 

T 

resulting equation by CM0DE3 , we get, 

T T T 

CMDDE3 CM3 CM0DE3 CU3 + co*CM0DE3 CM3 CMODE3CU3 + ci«CM0DE3 CK3 TM0DE3 CU3 

T T 

+ CM0DE3 CK3 CM0DE3 CU3 - CMODE3CP3 4.15 
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Now, 

NMii 0 0 O 

0 NM 22 0 O 

0 O NMaa 0 

0 0 0 NM 

Where , 

NMii=(Mn + mdai*M 2 i + mdai*Ma± + md4i*M4i) 

+ (Mia + md 2 i*M 22 + mdai*lia 2 + md4i*M4a)*mdai 

+ (Mia + md 2 i*M 28 + mdai*Maa + md4i*M48)*mdai 

+ (M14 + md2i*M24 + mdai*tia4 + md4i*M44> *md4i 

NM 22 =(Mn + md 22 *M 2 i + mda 2 *Mai + md42»M4i> 

+• (M 12 + md22»M22 + rrid 82 *Ma 2 + m d 42*M 42 ) *m d 22 
+ (Mia + mda 2 *Maa + mdsa*Maa + m d 42*M 4a > *m d a 2 
+ (Mi4 + md22*M24 + fnda2*lia4 + m d 42*1144 )*md 42 
NMaa= ( Mu + md 2 a*M 2 i + mdaa*Mai + md4a*M4i) 

+• (M 12 + ind 2 a*M 22 + mdaa*Ma 2 + md4a*M42) *rrid 2 a 

+ (Mia + mdaa*Maa +• mdaa*Maa + md48*ll48)*mda3 

+ (M 14 + md2a*M24 + fridaa*M84 + md 48*1144) *md 4 a 

NM44= (M 11 + md24*Mai + md84*M*i + md44*M4i) 

+ (Ml2 + md24*M22 + md84*M82 + md 44*M42 ) *fTl d 24 

+• (Mis + md24*M*8 + md84*M88 + md44*M48)*mdB4 

+ (Ml4 + md84*M84 + ITld 84*M*4 + ITld 44*1144} *md44 
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NKn 0 0 0 

_ 0 NKs2 0 0 

T 

C MODE 3 C K ] C MODE 3 = _ 

0 O NKaa 0 

"0 O 0 NK*4 

NKii=(Kii + md2i*Kai) + (K 12 + md2t*K22 + mdai*Ka2 + md4i*K42) *md2i 

+ (md 2 i»Kaa + mdai*Kaa + md4i*K4a)*mdai 
+ Cmd2i»K24 + mdai*Ka4 + m d 4i»K 44 ) *m d *i 
NKaa = (Kii+ md 22 *K 2 i) + (K 12 + md 22 *K 22 + mda 2 *Ka 2 + md 42 »K 42 .’> »md 22 

+ Cmd 22 »K 2 a + mda 2 *Kaa + md42*K4a) «mdaa 
+ ( Hid 22 *K 24 + mda2*Ka4 + md42*K44>*rrid42 
NKaa= (Kn+ md 28 *K 2 i) + <Ki 2 + md 28 *K 22 + frtdaa*Ka 2 + md48*K42)*md2a 

+ (md2a*K2a +■ mdaa*Kaa + md48»K48>*md88 


+ (md2a*K24 +■ mds8*K84 + m d 48*K 44 d 4 a 

NK44= (K 11 + md24»K2i) + (K 12 + md24«K22 + mda4*K32 + m d 44*K 42 ) *m d 24 

+ (.md24*K28 + ITid84*K88 + fTi d 44*K 43 ) *m d 84 

+ Cmd24*K24 + fTld84*Ka4 + IT! d 44*K 44 > *fTl d 44 


Pi + P2*md2i + Pa*mdai + P4*md4i 

PI + P 2 *md 22 + Pa*rrida 2 + P4*md42 

T 

[MODE]*[ P ] = Pi + P2*md28 + Pa*md88 + P4*md48 

Pi + P2*mda4 + Pa»mda4 + P4*md44 

The equations in independent co-ordinates are 
8 8 ■ 

NMn*Ui + (co*NMn + ci*Nkii)*Ui NKn«*Ui 




Pi + P 2 »ind 2 i + Pa*mdai +P4*md4i 


4. 15 



NM22*U2 + (C0*NM22 +• Cl*Nk22)*U2 ♦ NK22*U2 

« Pi + P 2 *md 22 + P»*rrid *2 +-P4«md42 4.17 

• * . 

NMaa*Ua + (co*NMaa + ci*Nkaa) *Ua NKaa*Ua 

= Pi ♦ P 2 *md 2 a + P8*mdaa +P4*md48 •, 4.18 

• » . 

NM44*L)4 + (CO*NM44 + Ci*Nk44)»U4 + NK44*l>4 

* Pi + Pa*md24 + Pa*mda4 +P4*md44 4.19 

4.1.8 RESPONSE OF THE END EFFECTOR 


Now depending upon whether Zb is sinusoidal or square the above 
set of equations can be solved accordingly. Then one can go 
back to equationi(.(u and get the response in the joint space. As 
soon as the response in the joint space is known, they can 
readily be converted to cartesian space to find the end effector 
response. 


One can write, 

AAA 

Rp = Ex*i •«- Ey*j + Ek*k 


Where, Rp is the position vector of 
with respect to the base co-ordinate frame. Ex, 

A 


the end effector 

A A 

Ey, Ex and i , j , 


k are the components and the unit vectors in X», Yb and Zb 
directions respectively. 

If Exo, Eyo,E*o are the components corresponding to the 


equi 1 ibr ium 


configuration, it can be written as 
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Ex - Exo = 

!_»• [S*®*C^»»(S*o*C»o«>C4o + S»o*Oo ) - ^44»Sso*S«o«Sso 

+ fp99 ( Sso*C40*Cso + Sso*Cao>} + Cio (^** , t , Sso*C 40 + ^ss*S 40 *CsoJ 

+ Si.o*£(La + L*)*^aa*Sao + ^2a*La»SaoJ .4, 20 

Ey ~ EyO — 

Ls* [-Cio*{^aa(S5o*Cao*C4o + 5ao*Cso> - ^ 44 »Sao*S 4 o*Sso 
+ ^SSS(Sa0*C40*C50 + SSO*Cao) } + SlO (^44*5S0*C40 + ^fr 55 »S 40 »C 50 ^ 


- Cio*[(La + L4)4‘^aa»Sao + ^a2*L2*Sao] 4.21 

Ez - Ezo = 

L 5 * Jji^a a ( Cao^Cso - Sao*Sso*C40) - ^>44*S40*S50*Cao + 

^es5CCao*C,40*C5o - 5ao*S»o)] 

+ jj^ 22 *L 2 *C 2 o + (La + L4)*^aa»Cao + ZbJ 4. 22 


The above equations give the position of the end effector at any 
time with respect to the equilibrium eonf igurat ion . 

The procedure of finding end effector response of a 5_D.0.F 
robot when subjected to random excitation is the same as 2JD.D.F 
system . Hence, to avoid c J. urns iness, the formula t. ion is not shown. 
Direct expressions would be used whenever required . 


4.2 : SIX D.O.F SYSTEM 

th 

If one observes the direction of rotation of the 6 joint, 

it can be noticed that there is no disturbing couple so that the 

4>V*ii VH 

6 link can vibrate . Hence the 6 lint can be taken as frozen 

with the 5 th link. Any arbitrary amount of rotation of the 6 th 

joint does not change the position of the EE tip. This is because 

it is axisymmetr ic and also the last link of the robot. Hence 
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ths contribution of the 6 th link to the system KE and PE can be 
found out without much headache as they are no way functions of 
4 > ■ 

^<50 

Hence , the only alteration to be made is to replace 

5 5 5 5 

* by F y y F y M® by CM5+M«*> and L.5 bv 

yy yy ** zz 

0_3+L<S> 

where, 

F stands for frozen 

and 

\ y - + ) * "•’•C-i# + -t* D + + 

% = + ^ 

2 i-. 

Now getting the new mass. Length and inertia of the 5 th link 
one can follow the same approach as of 5_D.0.F system to find the 
end effector response for any kind of excitation . 

4.3 SUMMARY 

This chapter has dealt with the response of the end effector 
of a five and six D.O.F manipulator for various type of 
excitations. The frequency equation 4.7 developed will give a 
basis of the stability of the system when perturbed from the 
equilibrium conf igurat ion. The modal analysis gives an idea of how 
the different modes take part in vibration. The expressions 

obtained m this chapter will be used m chapter 5 for numerical 
calculations and discussions. 



CHAPTER 5 
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NUMERICAL RESULTS AND DISCUSSIONS 

5. 1 THE INPUT PARAMETERS 

In chapter 4, the frequency equation 4.7 and the 
expressions for response Ceqn. 4. 20-4. 223 of the end-effector 
for different kind of loadings were derived. In order to perform 
numerical calculations with these equations, one must assign 
numerical values to the parameters that appear m these equations. 
These parameters are of two types - 

a> System parameters, such as mass, length, radius of the 
links, rotational stiffnesses of different joints etc. 

b> Non-system parameters, such as damping constant, joint 
angles, external loadings etc. 

System parameters are constant for a particular male of robot. 
The non-system parameters may vary depending upon the 
configuration of the structure and the environment in which it 
works. We have considered PUMA_560 as our system. The system 
parameters are chosen from ref.C163. These are given in Table 
5. 1 and 5. 2 

Selecting values for some of the non-system parameters is not 
an easy task. If one tries to analyze the system for the actual 
condition, he has to rely on experimental data, which in many 



44 


r. are derived an the basis of some simplifying acsumpt i ons, 
Joint damping values are difficult to obtain with reasonable 
accuracy because of its dependence on temperat ure , nature of 
1 uhr ican t etc. 

The author has assumed some value of the damping const ant 
0=0= 0.01 but other combination of values can be chosen. 

The external loading charat teristirs may depend on the 
operating environment. The study is confined to a ranye of 
frequencies varying between iO H7 to 500 HZ. which simulates the 
base excitation due to a rough surface, undulations in the path of 
the moving robot, or induced due to ground vibration. 


TABLE 5. 1 


LINK 

MASS U. g. 5 

LENGTH <mt. > 

RAD I US (mt. 1 

1 

12.96 


0. 17435 

2 

22.37 

0. 4318 

0.02637 

3 

5.01 

0.37382 

0.00648 

4 

1. 18 

0.05625 

0.0076157 

5 

0.62 

0.05625 

0.00424 

6 

0. 16 

0.00375 

0.002828 


The rotational stiffnesses of the joints are as follows: 
K± = 3*10* N-li/RADIAN. 

K 2— 1.8*10* N-M/ RADIAN. 

K 9 = 1 . 0*1 0*N -M/RADIAN. 
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K 4 -- Ks •- K«s =- 500 N-M/RADI AN. 

The joint range of the different joints are as follows 


TABLE: 5.2 


JOINT 

JOINT RANGE ( degree) 

1 

-160 TO 160 

'■n 

-225 TO 45 

3 

-45 TO 225 

4 

-110 TO J 70 

5 

-100 TO 500 

— * 

6 

-266 TO 266 


5.2 EFFECT OF JOINT PARAMETER VAR J AT I UN ON NATURAL FREQUENCIES 

The study of the nature t frequency of any system is very 
important in respect of understanding Lts behavior in the 
presence of any external forcing agent . A study has been inaoe 
for a 6_ D.O.F manipulator to 1-now the variation of the natural 
frequencies with respect to different parameters. These 
parameters include the joint stiffness, masses of the linLs, 
geometric configuration and the load at the tip. As mass and 
joint are the constant properties of a system, they are held fixed 
whereas the configuration & the load at the tip are varied for the 


purpose of our study- Amongst the 

different joint 

parameters , 

0a o 

© ° 

is varied between -135 to 135 at 

fixed 

values 

of 0ko, K ^ 

3. 

Within these limits the values 

of the 

joint 

parameters 

are 
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selected e.g. 610 - 135 , &to = 90°,^4o= <peo= tfxso =0°. 

The significance of this configuration is that the second link 
is vertical and others are at horizontal position when ^®o=0 . 

With the given values of the parameters, one can observe that 
the values of the third and the fourth natural frequencies 
are so high that their variation does not carry much importance in 
our study. As for example, tea varies between 330 rad/sec to 310 
rad/sec, and to* varies between 650 rad/sec to 600 rad/sec when <f>a o 
is varied between -135*to 135*. Hence, their study is excluded 
from the work. 

The dependence of on on ^ao is shown m Fig. 6. It may be 

O 

observed that to* starts decreasing from -135 to a minimum value 

© o 

at 91 and then from 91 onwards it starts increasing . The second 

O 

frequency <02 at first increases until it reaches a maximum at O 

O 

and thereafter, it decreases to a minimum at tfia o around 118 . 

o 

It may also be observed from Fig. 6 that for <pao <0 gm 

O 

increases with increasing load whereas for 4 >ao > 0 , it decreases 
with increasing load . All the "'P=constant •' curves intersect in 
the neighborhood of o = 0 . This shows very little dependence 
of wi on 'P' at this conf igurat ion. The reason for this dual 
behavior in the two regions of is as follows. 

When ^ao is increased in the positive region, the effective 
stiffness of the system decreases with increasing load at the 
tip whereas in the negative region of ^ao, the effective 
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stiffness shows a decline with more load 

In Figure 7 w® vs ipso r the behavior of 1 the different curves 
at constant P carries the same explanation as above. 

Let us now focus attention on the other side of coi v.s ipso. It. 
is notable that with the increase in value in 'P' , the curve d lps 
downward towards the «ps o axis when pao 0°. Hence , it is 

predictable that for some definite value of '?■ T ox. would contain 

zero value by touching the pao axis tangentially at <ps o - 91 “= 

4 * 

<pa . One can say that ihis frequency branch osculates the ^ao 
axis at this point. The particular value of P and <pa* are called 
the CRITICAL DIVERGENCE LOAD and OSCULATION ANGLE for the 
prescribed values of joint parameters. The significance of 

osculation is that it indicates the onset of instability m the 
system. 

5.3 : DEPENDENCE OF CRITICAL DIVERGENCE LOAD ON Sao 

Next, we examine the values of the critical divergence load 
as function of the equilibrium position of the third link of 
the manipulator . Given the equilibrium angles of the different 
joints, one can either solve the frequency equation 4.7 for 

P, with the condition « = 0 or by iteration method . Throughout 

this calculation the values ^ko , k m 3 are held fixed and <pso is 

varied between 0°and 180°. The choice of such range for pa o is 

obvious in the context that for pm < 0*, with the increase in 

load at the tip, ox. does not dip downward, instead it increases. 
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Hence with the increase in load the system will never reach to a 
critical configuration . 

In Fig. 8, it can be observed that the critical divergence 
load decreases when <poo varies from 0° to 91* and it 

Q 

increases when ^ao > 91 . The minimum value of the critical 
divergence load is 100 kg. and occurs at ^90=91°. It increases on 
either side of ^ao=91°. Hence for this value of <pao ,called 

osculation angle, the structure assumes the weakest configuration 
This characteristic is in conformity with Fig. 6. The nature of such 
behavior for a 3_D.0.F system is shown by Anderson C83. 

5.4 : RESPONSE OF THE END EFFECTOR 
5.4.1 : DETERMINISTIC EXCITATION 
A ' SINUSOIDAL LOAD 

The response plots for sinusoidal loading are shown m 

figC9 - 143. The plots for each D.O.F has been taken at two 
different forcing frequencies . These are w * 10 rad/sdc. and 

to® = 100 rad/sec. The nature of the plots at different D.O.F for 
&>i and toe shows the similar trend. This result shows that at 

higher frequencies there is participation of higher modes m 
the response. 

The other distinctive part of the curves lies in the transient 

part. At higher frequency, transient part stays for longer time 

with higher amplitude. But at lower frequency, transient part 
does not have significant amplitude and dies out faster . For 

high-speed operation of robot, the analysis of response at higher 
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frequency is required so that the end effector never crosses the 
stipulated limit of positional accuracy . 
h, LOAD PULSE 

The plots of response vs. square load is given m 
fig. C15 - 203. The analysis of the end effector response is 

performed at two different values of forcing frequencies as 
earlier . Square pulse may be thought of consisting of many 
sinusoidal waves with different amplitudes and frequencies. If 
any of these frequencies matches with the system natural 

frequency, the system will undergo large oscillation . But as the 

th 

system under consideration is damped and also for the fact the n 
harmonic in the square pulse possesses (l/n) th amplitude of the 
l ot harmonic, the system can be saved of severe damage m such 
occurrence . 

In comparison to the plots taken for sinusoidal input, the 
response is higher in this case. The steady state solution shows 
tendency to be of impulse type. This is distinctively visible for 
the lower frequency curve. The transient part is 
predominantly prevalent m the case of higher frequency . 

5.4.2 RANDOM EXCITATION 

In FI6.21, the plot of probability and response for different 
D.O.F robot subjected to white noise excitation is shown. The 
spectral density of excitation is taken 0.0001 nr* —sec/rad. The 
upper bound of frequency is taken to be 500 rad/sec. . 
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The characteristic of each of the curves is similar i.e with 
the increase in probability the response increases. The curve is 
steep near the origin and flat as probability approaches 
unity. The trend amongst the curves is that, for higher D.O.F, for 
3 particular probability, response decreases. This trend reverses 
for 6_D.0.F. The 6 link being a frozen link, increases the 

effective length of the 5 th link and so the end effector amplitude 

of oscillation also increases. 

5.5: A FEW RECOMMENDATIONS ON PUMA_56Q 

On the basis of the observations in this chapter, one can make 
a few recommendations on PUMA_560. These are as follows 
1) There are some critical values of P at each joint configuration 
for which the natural frequency of the system may be zero. The 
system will diverge and cause failure. Hence the maximum value of 
the external load P that can be carried by the end effector in a 

particular configuration should not exceed this critical value of 

P. To be on the safe side, the maximum load at the end effector 
must not be fixed above the lowest value of the critical 
divergence load that occurs at the osculation angle. 

2; At higher frequencies, the system response transients are 
large. So, m order to lessen this, damping in the joints should 
be increased. This will result in the steady state oscillations 
with low amplitudes. A special focus on the complex nature of the 
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system receptancp is necessary. At high frequencies, it does not 
die out but slowly assumes an almost constant value Ceqn. 3.3 3. 
This is of serious consideration when the system has random 
excitation. If any random process consists of a wide range of 
frequency, it will cause large oscillations at the joints and 
decrease the system performance to an alarming level. In this 
case, one can either increase the joint stiffnesses or isolate the 
vibration. Isolation of vibration can be done either at the source 
or m the robot mounting platform. The increase in joint stiffness 
will increase the natural frequencies which in turn reduces the 
transmittance at higher frequencies. 

Figure 21 shows that the end effector response for a 6_D.0.F 
robot is more than a 5_D.0.F robot fur the same spectral density. 
It means that any extension of the link after the 6 link should 
be done with due consideration as it may exceed the stipulated 
limit of positional accuracy. This also conforms to the robot 
design where the linkages are usually made to be more light weight 
as we reach near the end effector- 


113352 , 
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CONCLUSION 


6. 1 SUMMARY OF RESULTS 

In this investigation the natural frequencies of vibration, the 
conditions of stability and the end effector response of a 
mechanical manipulator with six rigid links have been 

determined. The links are connected through resilient joints that 
include restoring moments. The small oscillations of the lini-s 
with respect to an arbitrary equilibrium conf igurat ion have been 
studied and the values of the critical divergence loads have been 
calculated as function of the conf igur at ion of the manipulator. 
The response of the end effector for sinusoidal, square and random 
excitation has been found out at different values of forcing 
frequencies. A comparison of response has ben made amongst 
manipulators of three different types when subjected to 
ergodic and stationary random process. Plots of to vs. reveal 

that the first natural frequency, <oi, osculates the ^ao axis at a 
critical value of P acting at the tip of the manipulator. This 
proves to be the critical divergence load. The osculation angle 
is the angle at which the critical divergence force is a 
minimum for a given set of conf igur at ions . 
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At high frequency, when there is the participation of the 
higher modes in the response of the end effector, the transient 
response seems to be of considerable importance. Robots which are 
employed in high-speed operation, requires that the end effector 
response be dampened out in the quickest possible time. So, the 
selection of the damping parameters can accordingly be made from 
fig. 


6.2 SCOPE FOR FUTURE WORK 

The present work has the following scopes for future. 

1> Instead of cylindrical links, actual shapes of the links can be 
incorporated. 

2> Base excitation due to a variety of forcing functions for 
various makes of robots need to be investigated. 

3> There is a need for experimental determination of the joint 
damping parameter values to model the robots realistically. 

4> Elastic deformations of the flexible arms of the light weight 
robots should also be investigated as it may contribute to the end 
effector positioning error. 

5> An ideal white noise is not practically feasible. Response 
character ist ics of robots due to random excitation having 
varying spectral densities need to be studied. 
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FIG.4- sinusoidal excitation. 
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